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CLAIMS 

WHAT IS CLAIMED: 

1 . A signal filtering mechanism, comprising: 

a Kalman filter capable of receiving an input signal, a measured quantity signal, and a 
variance estimate signal for the measured quantity signal, and outputting a 
state estimate signal; and 

a variance estimator capable of estimating the variance of the measured quantity 
signal and generating the variance estimate signal for use in filtering the input 
signal and the measured quantity signal, wherein estimating the variance of the 
measured quantity signal includes determining a smoothed estimate of the 
measured quantity's variance from the measured quantity signal. 

2. The signal filtering mechanism of claim 1, wherein determining the smoothed 
estimate comprises: 

determining the squared instantaneous prediction error of the measured quantity 
signal; 

smoothing the determined, squared instantaneous prediction error; and 
estimating the measured quantity's variance from the smoothed squared instantaneous 
prediction error. 

3. The signal filtering mechanism of claim 1, wherein determining the smoothed 
estimate comprises: 

determining the absolute instantaneous prediction error in the measured quantity 
signal; 

smoothing the determined, absolute instantaneous prediction error; and 
estimating the measured quantity's variance from the smoothed absolute 
instantaneous prediction error. 

4. A method for estimating the variance of a measured quantity used to predict 
the current state of a discrete, vector-state, scalar-measurement system, the method 
comprising: 

estimating the variance of a measured quantity for use in filtering an input quantity 
and the measured quantity; 



Page 19 of 29 



# 

WMA Docket No. 2063.001700 
Client Docket No. VS-533 



6 determining a smoothed estimate of an instantaneous prediction error's variance; and 

7 filtering the input quantity and the measured quantity through a Kalman filter using 

8 the estimated input variance of the measured quantity signal. 

1 5. The method of claim 4, wherein determining the smoothed estimate of the 

2 variance of the instantaneous prediction error of the measured quantity signal comprises: 

3 determining the squared instantaneous prediction error in the measured quantity 

4 signal; 

5 smoothing the determined, squared instantaneous prediction error; and 

6 estimating the variance from the smoothed squared instantaneous prediction error. 

i 6. The method of claim 5, further comprising initializing a plurality of quantities 

\ir. used in estimating the current state of the discrete, vector-state, scalar-measurement system. 

C3 

7. The method of claim 6, wherein initializing the plurality of quantities includes: 

iu 

Ul setting the prediction of the initial state of the system to a first predetermined value; 

Ul , 

and 

- f 4 3 setting the initial prediction covariance matrix associated with the predicted initial 

Is state of the system to a second predetermined value; and 

?! i 

1 1 one of: 

S setting the error filter gain to a third predetermined value; or 

t:o? 

l& setting the smoothed squared instantaneous prediction error to 0. 

1 8. The method of claim 7, wherein the third predetermined value is a vector of 

2 ones. 

1 9. The method of claim 7, wherein the error filter gain is set to a third 

2 predetermined value and filtering the input quantity and the measured quantity includes 

3 determining a Kalman filter gain vector, a current state vector estimate, and a state vector 

4 estimate covariance matrix after estimating the variance of the measured quantity. 

1 10. The method of claim 7, wherein the smoothed squared instantaneous 

2 prediction error is set to 0 and filtering the input quantity and the measured quantity includes 

3 determining a Kalman filter gain vector, a current state vector estimate, and a state vector 

4 estimate covariance matrix before estimating the variance. 
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1 1 . The method of claim 4, wherein determining the smoothed estimate of the 
variance of the instantaneous prediction error of the measured quantity signal comprises: 

determining the absolute instantaneous prediction error in the measured quantity 
signal; 

smoothing the determined, absolute instantaneous prediction error; and 
estimating the variance from the smoothed absolute instantaneous prediction error. 

12. The method of claim 11, further comprising initializing a plurality of 
quantities used in estimating the current state of the discrete, vector-state, scalar- 
measurement system. 

13. The method of claim 12, wherein initializing the plurality of quantities 



setting the prediction of the initial state of the system to a first predetermined value; 
and 

setting the initial prediction covariance matrix associated with the predicted initial 
state of the system to a second predetermined value; and 

one of: 

setting the error filter gain to a third predetermined value; or 
setting the smoothed absolute instantaneous prediction error to 0. 

14. The method of claim 13, wherein the third predetermined value is a vector of 

ones. 

15. The method of claim 13, wherein the error filter gain is set to a third 
predetermined value and filtering the input quantity and the measured quantity includes 
determining a Kalman filter gain vector, a current state vector estimate, and a state vector 
estimate covariance matrix after estimating the variance of the measured quantity. 

16. The method of claim 13, wherein the smoothed absolute instantaneous 
prediction error is set to 0 and filtering the input quantity and the measured quantity includes 
determining a Kalman filter gain vector, a current state vector estimate, and a state vector 
estimate covariance matrix before estimating the variance. 



includes: 
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1 17. A method for estimating the current state of a discrete, vector-state, scalar- 

2 measurement system, the method comprising: 

3 determining a current state vector prediction from a previous state vector estimate and 

4 an input vector; 

5 determining a current state vector prediction covariance matrix associated with the 

6 current state vector prediction from a previous state vector covariance matrix 

7 associated with the previous state vector estimate; 

8 estimating the variance of a measured quantity, wherein estimating the variance 

9 includes: 

10 determining a squared instantaneous prediction error of the measured quantity 
i i from the measured quantity and one of the current state vector estimate 
K and the previous state vector estimate; 

|>[ smoothing the squared instantaneous prediction error; and 

H| estimating the variance of the measured quantity from the smoothed squared 

f£ instantaneous prediction error; 

CP determining a current Kalman filter gain vector* from the current state vector 

1% prediction covariance matrix and the measured quantity variance estimate; 

if determining a current state vector estimate from the Kalman filter gain, the current 

M state vector prediction, and the measured quantity; 

|ft determining the current state vector covariance matrix associated with the current 

21 state vector estimate from the Kalman filter gain and the current state vector 

22 prediction covariance matrix; and 

23 iterating the above. 

1 18. The method of claim 17, further comprising initializing a plurality of 

2 quantities used in estimating the current state of the discrete, vector-state, scalar- 

3 measurement system. 

1 19. The method of claim 18, wherein initializing the plurality of quantities 

2 includes: 

3 setting the value of the current state vector prediction to a first predetermined value; 

4 setting the current state vector prediction covariance matrix to a second predetermined 

5 value; and 
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performing one of: 

setting an error filter gain to a third predetermined value; or 
setting the squared instantaneous prediction error to 0. 

20. The method of claim 17, wherein the current state vector estimate, the current 
state vector prediction covariance matrix, and the current Kalman filter gain are updated after 
the variance of the measured quantity is estimated. 

21. The method of claim 20, wherein, in estimating the variance of the measured 
quantity includes: 

determining the squared instantaneous prediction error in the measured quantity 
includes applying the following analysis: 



smoothing the determined, squared instantaneous prediction error includes applying 



estimating the variance of the measured quantity from the smoothed squared 
instantaneous prediction error comprises: 

setting the estimated variance to a fourth predetermined value if the Kalman 

filter is not stable; or 
applying the following analysis if the Kalman filter is stable: 



e 2 [n] = (z[n]-H[n]x[n\n-l]f; 



the following analysis: 



°l M = *e [« " J ] + H \*\ G \- n t e 2 M ~ °l Vn - 1]) ; and 



determining the value of a[n] from: 



H[n]A[n]H[n] 
H[n]H[nf 



T 



a[n} = 



determining the value of q[ri\ from: 




R[n] 2 (2a 2 [n] - 1)+ R[n][a 2 [n]{\ - 3a 2 [«])- 2q[n]]+ &] [n](q[n] + a 2 [n]a 2 [«])= 0 . 
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1 22. The method of claim 1 7, wherein the current state vector estimate, the current 

2 state vector prediction covariance matrix, and the current Kalman filter gain are updated 

3 before the variance of the measured quantity is estimated. 

1 23. The method of claim 22, wherein, in estimating the variance of the measured 

2 quantity includes: 

3 determining the squared instantaneous prediction error of the measured quantity 

4 includes applying the following analysis: 

5 e 2 [n] = (z[n]-H[n]x[n]f; 

6 smoothing the determined, squared instantaneous prediction error includes applying 

7 the following analysis: 

*l M = °l [" - 1] + H[n] G[n](e 2 [«] - a] [n - 1]) ; and 



SW3 



m estimating the variance from the smoothed squared instantaneous prediction error 

W " . 

im comprises: 

\% setting the estimated variance to a fourth predetermined value if the Kalman 

12 filter is not stable; or 

lgy applying tlie following analysis if the Kalman filter is stable: 

\W[ determining the value of a[ri\ from: 



19 



20 



H[n]A[n]H[n] T . 
a[n\ = — ; 

H[n]H[n] T 



16 determining the value of g[n] from: 

17 g[n] = (H[n]B[n]]Q[n](H[n]B[n]) T ; and 

18 solving for R[ri] from 



24. A signal filtering mechanism, comprising: 
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means for receiving an input signal, a measured quantity signal, and a variance 
estimate signal for the measured quantity signal, and outputting a. state 
estimate signal; and 

means for estimating the variance of the measured quantity signal and generating the 
variance estimate signal for use in filtering the input signal and the measured 
quantity signal, wherein estimating the variance of the measured quantity 
signal includes determining a smoothed estimate of the measured quantity's 
variance from the measured quantity signal. 

25. The signal filtering mechanism of claim 24, wherein determining the 
smoothed estimate comprises: 

determining the squared instantaneous prediction error of the measured quantity 
signal; 

smoothing the determined, squared instantaneous prediction error; and 
estimating the measured quantity's variance from the smoothed squared instantaneous 
prediction error. 

26. The signal filtering mechanism of claim 24, wherein determining the 
smoothed estimate comprises: 

determining the absolute instantaneous prediction error in the measured quantity 
signal; 

smoothing the determined, absolute instantaneous prediction error; and 
estimating the measured quantity's variance from the smoothed absolute 
instantaneous prediction error. 

27. A apparatus for estimating the variance of a measured quantity used to predict 
the current state of a discrete, vector-state, scalar-measurement system, the method 
comprising: 

means for estimating the variance of a measured quantity for use in filtering an input 

quantity and the measured quantity; 
means for determining a smoothed estimate of an instantaneous prediction error's 

variance; and 

means for filtering the input quantity and the measured quantity through a Kalman 
filter using the estimated input variance of the measured quantity signal. 
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1 28. The apparatus of claim 21 , wherein the means for determining the smoothed 

2 estimate of the variance of the instantaneous prediction error of the measured quantity signal 

3 comprises: 

4 means for determining the squared instantaneous prediction error in the measured 

5 quantity signal; 

6 means for smoothing the determined, squared instantaneous prediction error; and 

7 means for estimating the variance from the smoothed squared instantaneous 

8 prediction error. 

1 29. The apparatus of claim 27, wherein the means for determining the smoothed 

2 estimate of the variance of the instantaneous prediction error of the measured quantity signal 
f h comprises: 

Jg? means for determining the absolute instantaneous prediction error in the measured 

BJ quantity signal; 

|j means for smoothing the determined, absolute instantaneous prediction error; and 

means for estimating the variance from the smoothed absolute instantaneous 

3 prediction error. 

^ 30. A program storage medium encoded with instructions that, when executed by 

y a computing apparatus, perform a method for estimating the variance of a measured quantity 

§2 used to predict the current state of a discrete, vector-state, scalar-measurement system, the 

4 method comprising: 

5 estimating the variance of a measured quantity for use in filtering an input quantity 

6 and the measured quantity; 

7 determining a smoothed estimate of an instantaneous prediction error's variance; and 

8 filtering the input quantity and the measured quantity through a Kalman filter using 

9 the estimated input variance of the measured quantity signal. 

1 31. The program storage medium of claim 30, wherein determining the smoothed 

2 estimate of the variance of the instantaneous prediction error of the measured quantity signal 

3 in the encoded method comprises: 

4 determining the squared instantaneous prediction error in the measured quantity 

5 signal; 
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smoothing the determined, squared instantaneous prediction error; and 
estimating the variance from the smoothed squared instantaneous prediction error. 

32. The program storage medium of claim 30, wherein determining the smoothed 
estimate of the variance of the instantaneous prediction error of the measured quantity signal 
in the encoded method comprises: 

determining the absolute instantaneous prediction error in the measured quantity 
signal; 

smoothing the determined, absolute instantaneous prediction error; and 
estimating the variance from the smoothed absolute instantaneous prediction error. 

33. A computing apparatus programmed to perform a method for estimating the 
variance of a measured quantity used to predict the current state of a discrete, vector-state, 
scalar-measurement system, the method comprising: 

estimating the variance of a measured quantity for use in filtering an input quantity 

and the measured quantity; 
determining a smoothed estimate of an instantaneous prediction error's variance; and 
filtering the input quantity and the measured quantity through a Kalman filter using 

the estimated input variance of the measured quantity signal. 

34. The computing apparatus of claim 33, wherein determining the smoothed 
estimate of the variance of the instantaneous prediction error of the measured quantity signal 
in the programmed method comprises: 

determining the squared instantaneous prediction error in the measured quantity 
signal; 

smoothing the determined, squared instantaneous prediction error; and 
estimating the variance from the smoothed squared instantaneous prediction error. 

35. The computing apparatus of claim 33, wherein determining the smoothed 
estimate of the variance of the instantaneous prediction error of the measured quantity signal 
in the programmed method comprises: 
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determining the absolute instantaneous prediction error in the measured quantity 
signal; 

smoothing the determined, absolute instantaneous prediction error; and 
estimating the variance from the smoothed absolute instantaneous prediction error. 
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